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ABSTRACT 

The  forward  and  reverse  solutions  of  a  manipulator  with  six  joints  are  expanded  up 
to  second  order  in  the  24  joint  parameters. 
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1  INTRODUCTION 

It  is  well  known  that  the  absolute  accuracy  of  most  available  robotic  manipulators 
is  relatively  poor.  If  the  robot  is  commanded  to  move  to  a  certain  position  in  world 
space,  it  will  actually  move  to  a  slightly  different  position.  Typically,  the 
differences  between  the  commanded  and  the  actual  position  may  be  of  the  order  of 
.5%  of  the  dimensions  of  the  robot.  In  absolute  terms,  this  inaccuracy  could  be 
between  .1  and  1.2  inches  (Kumar  and  Waldron  1981,  Mooring  1983).  The  magnitude 
of  this  error  is  significantly  above  acceptable  tolerance  limits  for  most  manufacturing 
applications. 

If  the  robot  is  programmed  by  conventional  teaching-by-doing  methods,  problems  of 
absolute  accuracy  are  of  no  importance  because  they  are  corrected  through  the  visual 
feedback  of  the  human  operator. 

Current  trends  indicate,  however,  that  in  the  near  future  robots  will  be  programmed 
off-line  with  the  help  of  model  based  systems.  In  such  an  integrated  environment,  it 
is  of  vital  importance  that  the  computer  model  of  the  robot  maps,  as  closely  as 
possible,  its  physical  pendant.  Hence  the  need  arises  for  developing  mathematical 
tools  to  obtain  the  signature  of  individual  errors  and  project  it  into  the  model  as 
closely  as  possible. 

It  is  important  to  note  that  the  overall  errors  of  the  robot  are  of  a  geometric  and  a 
non-geometric  kind.  The  latter  ones  may  be  due  to  joint  compliance,  gear 
transmission  errors  and  backlash  {Whitney,  et  al.  1984;  Mooring  1983;  Whitney  and 
Lozinski  1984).  The  former  ones  may  result  from  imprecise  manufacturing  of  the 
robot  links  and  joints.  Deviations  in  the  relative  link  positions,  i.e.,  encoder  errors  or 
offsets,  will  be  part  of  the  geometric  error. 

Depending  on  the  actual  application  of  the  manipulator,  errors  of  one  kind  or 
another  may  become  predominant.  In  high  speed  assembly  operations,  in  particular, 
dynamic  errors  might  be  more  important  than  errors  in  the  manipulator  geometry.  In 
applications  like  welding  or  slow  motion/high  precision  tasks,  the  situation  is  likely 
to  be  reversed. 

j  This  paper  attempts  to  establish  a  mathematical  reference  frame  for  geometric 
errors  only.  No  attempt  is  made  to  quantify  the  relative  contribution  of  geometric 
and  non-geometric  errors,  since  this  ratio  is  application  dependent  and  will  also 
depend  on  the  design  of  the  manipulator  itself.  Since  in  high  speed  operations  high  w  ) 
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positional  accuracy  is  desirable,  we  address  the  question  of  how  to  cope  with 
geometric  deviations  from  the  ideal  manipulator  configuration. 

•»  /yyyt^AMt^  /^V*  J  ^  J.  <^- 

Due  to  manufacturing  errors,  each  of  the  robot  links  will  be  slightly  different  from 
the  ideal  one.  For  an  N  degree  of  freedom  manipulator  there  will  be  N  joints  and  N 
links.  Each  of  the  links  can  be  characterized  by  two  dimensions:  the  normal 
distance  a  between  the  joints  it  connects,  and  the  twist  angle  a  between  the  joint 
axes  it  connects.  If  the  design  calls  for  certain  values  of  a  and  «,  the  real  robot 
will  have  link  values  a  +  Aa  and  a  *  A  a.  Each  joint  sits  between  two  links  that 
intersect  the  joint  axis.  The  distance  d  between  the  subsection  of  the  links,  as  well 
as  the  angle  9  between  the  links  measured  on  a  plane  normal  to  the  joint  axis, 
characterizes  the  joint.  If  the  design  calls  for  certain  values  of  d  and  6,  the  real 
robot  will  have  joint  values  d  ♦  Ad  and  9  *  A9  (Paul  1981). 

Each  of  the  joint-link  pairs  achieves  a  rotation  by  an  angle  a,  followed  by  a 
translation  of  d  and  a  in  different  directions,  followed  once  more  by  a  rotation  by 
an  angle  a.  The  real  robot  will  effect  these  by  amounts  a  ♦  A  a.  d  ♦  Ad,  a  ♦  Aa  and 
9  +  A 9.  The  computation  of  subsequent  rotation,  translation  and  rotation  is 
straightforward.  Of  the  various  representations  of  the  resulting  screw  displacement 
that  are  possible  (Rooney  1978),  the  most  popular  among  roboticists  is  the  use  of 
homogeneous  4x4  matrices.  The  concatenation  of  N  such  joint-link  pairs  gives  the 
final  transformation  that  describes  the  translation  and  rotation  of  the  end  effector 
relative  to  the  base  of  the  robot. 

This  calculation  can  be  done  for  both  the  ideal  and  the  real  robot.  For  a  six 
degrees  of  freedom  robot  6  x  4  >  24  joint-link  parameters  exist,  but  only  six  of 
these  parameters  need  to  be  controllable,  the  other  eighteen  remaining  fixed  and 
uncontrolled.  In  the  following,  we  will  denote  the  24  joint-link  parameters  by  the 
variables  plf...,p24,  with  the  first  six  p1#«„,p  chosen  to  represent  the  six  joint-link 
variables  that  are  being  controlled.  For  the  Stanford  manipulator,  they  would  be 
(p1f...,P6)  «  (9 1'®2'C^3'^4'^5'^6^'  whereas  *0r  the  elbow  manipulator  described  by  Paul 
(1981),  they  would  be  (p1 . pg>  «  (9 y9 2,d y9 ^.9 s,9 J. 

It  is  not  difficult  to  compute,  for  both  the  ideal  and  the  real  robot,  the  so-called 
forward  solution  that  describes  the  translation  and  rotation  of  the  end  effector 
relative  to  the  robot  base.  The  same  formal  expressions  result  for  both  robots,  but 
with  the  values  p1  *  Apt,...,p24  *  ApJ4  replacing  the  values  p1,...,p24,  if  Ap1,...,Ap24 
are  the  errors  of  the  24  joint-link  parameters.  Although  the  result  for  the  real  robot 
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is  considerably  more  complicated,  it  stilt  is  of  manageable  proportions  and  can  be 
given  in  an  analytic  expression. 

Since  the  errors  will  be  small,  it  is  tempting  to  expand  the  real  forward  solution 
around  the  ideal  one  in  powers  of  the  errors  Ap^-^Ap  .  Calculations  by  Chi-haur 
Wu  (1984)  confirm  the  practical  result  that  for  the  real  robot,  translation  and  rotation 
of  the  end  effector  are  not  quite  what  they  are  meant  to  be  (i.e..  the  translation  and 
rotation  achieved  by  the  ideal  robot).  They  also  show  that  the  errors  of  a  particular 
link  propagate  in  a  complicated  way  through  the  other  links  that  connect  it  to  the 
end  effector. 

The  real  problem  arises  if  one  wishes  to  find  which  values  of  the  joint  variables 
P1#...,P6  assure  a  certain  position  of  the  end  effector.  Since  the  forward 
transformation  is  highly  nonlinear,  its  inversion  is  not  a  simple  task.  In  practice,  it 
can  only  be  done  for  relatively  simple  configurations  where  most  of  the  18  joint-link 
parameters  p?,....p24  are  identically  zero.  Since,  by  definition,  this  is  not  the  case 
for  the  real  robot,  the  exact  inverse  solution  of  the  real  robot  is  almost  impossible 
to  find!  So  far,  even  approximations  to  the  real  reverse  solution  have  been  lacking— 
it  was  simply  assumed  that  the  real  inverse  solution  is  identical  to  the  ideal  one. 

If  a  robot  is  given  the  task  of  reaching  a  particular  position,  the  joints  are  adjusted 
to  values  p,,...,p_  computed  from  the  ideal  reverse  solution.  If  the  robot  were  error 
free,  it  would  indeed  reach  the  prescribed  position.  If  it  is  not  error  free,  the 
prescribed  position  is  not  reached.  This  is  because  the  ideal  reverse  solution  is 
being  used  to  find  the  values  p,,...,p_,  which  are  then  propagated  through  the  real 

I  D 

forward  solution.  Since  idea!  reverse  and  real  forward  solution  do  not  close,  errors 
in  the  positioning  of  the  end  effector  are  the  result. 

The  task  of  geometric  robot  calibration  can  be  defined  as  finding  the  errors 

Ap1 Ap24  and  constructing  the  appropriate  real  reverse  and  forward  solutions.  The 

errors  could,  for  example,  be  measured  by  triangulation  of  the  robot. 

An  intermediate  step  to  geometric  robot  self-calibration  avoids  this  triangulation  of 
the  joints  and  links  of  the  robot,  and  replaces  it  by  triangulation  of  the  positioning 
of  the  end  effector.  From  these  errors  the  errors  Ap1,...,Ap24  are  deduced  and  then 
used  in  the  real  forward  solution.  The  task  is  to  find  corrections  3p,,...,£p_  of  the 
joint-link  variables  so  that  the  real  robot  (with  Ap1„..,Ap24  #  0)  reaches  the  same 
positioning  as  the  ideal  robot  (with  vanishing  errors  Ap1  *  ...  *  Ap24  *  0).  Once  the 
mapping  how  the  joint  corrections  depend  on  the  joint  coordinates 
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ip^Pj.—Pg) 

(1.1) 

iPg(pn.~«P6) 

is  established,  it  can  be  used  for  further  error-free  manipulations.  This  approach  is 
taken  in  this  paper. 

Complete  geometric  self-calibration  would  be  a  strategy  by  which  the  robot 

searches  for  certain  calibration  points  by  skillful  variation  of  £p ,Spe.  The 

resulting  mapping  like  (1.1)  could  then  be  stored  without  actual  evaluation  and  use  of 
the  errors  Ap1>...,Ap24. 


2  FORWARD  SOLUTION 

To  find  the  forward  solution  for  the  real  robot,  one  needs  to  start  with  the  A 
matrices  of  the  individual  links. 


The  A  matrix  for  the  ideal  robot  is  of  the  form  (Paul  1981) 


A'  - 

I 
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(2.1) 


and  the  A  matrix  of  the  real  robot  is 

cos(d.+Ad )  -sin(d.*Ad  )cos(«  +Aa  ) 

ii  ii  i  i 
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sin(d+Ad.)sin(«.+Ac.) 

I  I  I 
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ii  ii 

(a  ♦Aa.)sin(d.+Ad ) 

ii  ii 
r  +Ar. 
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(2.2) 


These  matrices  are  multiplied  to  obtain  the  ideal  and  real  forward  transformations 


T1  *  A  'A  1  A  ' 
i  z 

Tr  ■  A  rA  r  A  r 

i  ••• 


(2.3) 

(2.4) 


Although  the  complete  forward  transformation  Tr  can  be  written  down  in  closed 


form,  such  an  expression  would  be  of  little  practical  use.  Although  the  inverse 
transformation  (T1)-1  of  the  ideal  forward  transformation  can  be  written  down  in 
analytic  form,  it  is  unlikely  that  such  an  expression  could  be  found  for  the  real 
inverse  (Tr)_1. 

Since  the  differences  Ad,..., Ad.,  Aa,,...,Aac,  Ar . ,Arc  and  Aa,,...,Aac  are  assumed  to 

I  0  1  0  10.1  o 

be  small,  it  is  more  advantageous  to  expand  Tr  around  T1  in  powers  of  these  errors. 
This  gives,  up  to  second  order  in  errors  AA.  of  the  A  matrices. 

Tr  -  T*  *  Tr(AA  *  0)  -  Tr(AA.  =  0) 

I  I 


y  A .  #•*•?  AA 

1  i  c 


6  6 


A  AA  AA  A 

1  I  JO 


Since 


+  ^  A  A2A  A 

i  >  1  i  6 


3  A.  3  a.  3a.  3a 

^'aT'ar'aT'0  ,or  1 '  * 

J  J  J  J 


the  linear  errors  are  given  by 


3a  3  a.  3  a.  3a. 

AA.  =  — 5  Ad  *  — !  As.  +  — — -  Ar.  ♦  1  Aa 

1  30  1  3a.  '  3r  '  3a  1 

I  I 
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I  I 


,  32a.  .  32a  j  2  32a  32a 
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a^A. 

*  StfST  1  ■  1~® 

i  i 

Ar  *Aa *0 

I  I  . 

with  no  sums  on  tne  index  i.  All  the  error  matrices  AA,,...,AA*  have  by  now  been 
represented  as  homogeneous  matrices  multiplied  by  the  24  scalars  Ad.,  A  a.,  At.,  Aa 
where  i  »  1,...,6. 

Fortunately,  the  expansion  (2.8)  looks  more  complicated  than  it  really  is.  Megahed 
and  Renaud  (1982)  and  Wu  (1984)  noticed  that  the  first  derivatives  of  the 
transformation  matrices  A.  are  linear  functions  of  the  matrices  themselves  and  can 
be  written  as 


r-r  *  A  Q 
30.  1  1 


— — -  *  A.Q 
3  a.  1 


3A 
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(2.10) 
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(2.12) 


where 
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Thus  the  differentiations  are  merely  matrix  multiplications 
AA  =  A  [Q.^Afl.  +  QaAa.  +  Q.rAr.  +  QaAa] 

I  I  I  I  III  I 


and 


A2A  =  A.tQ.^Q  ^  (A 9)2  ♦  QflQa  <A«  )2  +  Q  rQ  r  (Ar.)2  +  QaQa(Aa  )2 
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I  I  I 

It  should  also  be  noted  that  Qa  and  Qa  are  the  same  for  all  the  links, 
difference  Tr  -  T1  can  be  written  as  a  multiple  of  T1: 


Tr  -  T1 
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where 
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Finally,  the 
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The  problem  of  computing  derivatives  like  those  above  also  arises  in  robot 
dynamics  (Brady,  et  al.  1982).  Recursive  methods  as  proposed  by  Hollerbach  (1980) 
and  Book  (1983)  reduce  the  problem  to  linear  complexity,  but  nonlinear  complexity 
schemes  might  actually  be  faster  (Luh,  Walker  and  Paul  1980;  Walker  and  Orin  1982). 
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As  an  example  we  give  the  matrices  dA  1/3«  1  and  3  A)/3«13«]  for  the  first  link  of 
the  Stanford  manipulator.  Its  variable  is  #  ,  and  the.  ideal  link  parameters  are  a  = 


-90  ,  a  *  d  *  0.  One  obtains,  up  to  second  order  in  A  a. 
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where  we  left  out  3  other  linear  terms  and  15  other  quadratic  terms. 


At  this  point  there  is  no  difference  between  link  variables  and  link  parameters,  and 
one  could  write 


T(p  ♦  Ap.)  -  T(p.)  *  Tr(p.)  -  T'(p.)  * 


(2.22) 


3T  -ii  92T 

2.  ^  4Pi  *  Z  4PAP 


i«1 

24 


rr3 


i* i  i«i  ■■  rrj 

24  24 
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X  K(  4pi  *  XX  4p.  Lij  4pj 


i*  1 


j«1 


Here  T,  K.  and  L..  are  4  x  4  homogeneous  matrices,  with  the  indices  i  and  j  not  being 
the  matrix  index  but  running  from  1,...,24.  There  are  24  matrices  K..  Since 


L..  «  L.. 

•J  J' 


(2.23) 


there  are  24  •  25/2  ■  300  matrices  L...  Computation  of  the  24  matrices  K.  by  hand  is 
still  feasible  (and  was  done  by  Wu  (1984)  for  the  general  case),  but  computation  of 
the  300  second  order  matrices  is  better  left  to  some  algebraic  manipulation  routine. 
The  K.  and  L..  matrices  are  not  as  complicated  as  might  appear  at  first  sight  because 
not  all  the  errors  Ap1>...,Ap24  are  of  the  same  importance. 

Considering  one  particular  A.  matrix,  like  (2.2),  it  can  be  seen  that  the  3x3  rotation 
matrix  in  the  upper  left-hand  corner  involves  only  the  rotational  errors  A  d.  and  A  a., 
while  the  translational  part,  which  are  the  first  three  elements  of  the  last  column, 
involve  both  the  translational  errors  Aa.  and  Ar.  as  well  as  the  rotational  error  Ad., 
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but  not  Aa..  The  way  these  errors  in  the  individual  (A.  +  AA.)  matrices  propagate 
into  the  final  (T  +  AT)  matrix  becomes  more  transparent  if  the  multiplicative  structure 
(2.3),  (2.4)  is  changed  to  a  polynomial  one  that  separates  rotation  and  translation.  In 
such  a  representation  the  total  rotation  R  and  total  translation  t  derive  as  follows 
from  the  individual  R.  and  t.  of  the  .A.  The  total  transformation  consists  of  a 
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rotation  R  followed  by  a  translation  t  so  that 


Rx  +  t  «  R1  [...[R5(Rgx  ♦  tg)  +  t5J}  +  tt 


(2.24) 


Comparison  of  terms  shows  that 


R  *  R,R_R„RR,R_ 

1  2  3  4  5  6 

t  *  RiR2R3R4R5t6 

+  R1R2R3R4t5 

+  ^2^4 

*  R1R2t3 
4  R1l2 


(2.25) 


(2.26) 


Not  all  the  errors  occur  in  all  the  matrices  and  vectors.  Upon  inspecting  (2.2),  one 
sees  that  only  the  rotational  errors  Ad  and  Aa.,  i  *  1.....6  affect  the  total  rotation  R 


'.s7 


vs.  s  s  *  a  'r  .w.r.w.w 
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while  all  errors  Ad.,  A  a.,  Ar.,  Aa.,  i  «  1.....6  affect  the  total  translation  F— with 
exception  of  Aag.  This  remark  is  correct  to  any  power  in  the  expansion  in  the 
errors.  Up  to  first  order  the  perturbed  AR  and  aF  are  not  made  up  of  4  x  6  =  24 
and  4  x  21  =  84  terms.  In  the  perturbed  AR  there  are  only  12  terms  linear  in  Ad.  and 
Aa.,  i  *  1,...,6  and  no  terms  in  Ar.  and  Aa..  In  the  perturbed  total  translation  aF  there 
are  6  terms  linear  in  Aa.,  i  =  1,...,6  and  6  terms  linear  in  Ar.,  i  =  1,...,6.  In  the  sum 
for  aF  there  are  also  (6-i)  terms  in  Aa.,  i  *  1.....6  and  (7-i)  terms  in  Ad.,  i  *  1,...,6. 
Altogether  there  are  only  60  and  not  84  terms.  Errors  in  the  joint  coordinate  Aff } 
and  parameters  Aa  1  propagate  most  into  the  total  translation  F,  errors  Ad.  and  A  a  of 
higher  indexed  links  less  so,  until  the  error  Aa.  of  the  last  link  does  not  affect  the 
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total  translation  at  all. 

3  ERROR  EVALUATION 

The  forward  transform  matrices  used  hitherto  are  redundant.  Physically  the  position 
of  the  end  effector  is  characterized  only  by  6  scalar  quantities.  Three  of  them  are 
the  components  of  the  translation  vector,  or  T,.,  and  T.,  of  the  4  x  4  T-matrix. 

The  other  three  could  be  chosen  as  some  three  components  of  the  rotational  part  of 
the  T-matrix,  say  Tn,  T12  and  T23>  These  are  the  direction  cosines  between  two  of 
the  reference  axes  and  the  three  axes  of  the  end  effector.  The  way  the  rotation 
parameters  are  measured  for  calibration  purposes  is  largely  a  matter  of  convenience. 
Other  components  of  the  rotation  matrix  or  combinations  of  components  could  be 
used.  Mathematically  the  most  elegant,  but  in  practice  not  least  cumbersome  way 
would  be  to  use  the  axis  of  rotation  which  is  the  eigenvector  of  the  rotation  matrix 
and  the  angle  of  rotation  C  which  can  be  deduced  from  the  trace  Tr  R  of  the 
rotation  matrix  as 

C  *  arc  cos[{Tr  R  -  1)/2]  (3.1) 

The  rotation  could  then  be  described  by  the  three  components  of  the  rotation  vector 
which  points  in  the  direction  of  the  eigenvector  of  R  and  is  of  length  tg({72)  where 

tg2(C/2)  «  (2  -  Tr  R)/Tr  R  (3.2) 

In  the  following  we  will  not  specify  how  the  resulting  transformation  is  represented, 
but  we  will  merely  speak  of  Cartesian  coordinates  x,,...,x_,  which  are  not  necessarily 
of  vectorial  character.  They  are  simply  six  scalar  functions  that  describe  the 
position  of  the  end  effector. 


The  first  task  is  to  find  the  24  errors  Ap^'Ap  from  6  measured  Cartesian  errors 
Ax,,...,Ax_.  If  one  expands  the  difference  between  the  position 
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x.(pr..,p6;  Ap  y !•••»  Apg;  p? . P24;  Ap  Ap24) 

the  real  robot  reaches  when  its  joint  coordinates  have  the  values  p,,...,pe,  and  the 

1  D 

position 

X(P  ^  riofPgJ  OfiwfO,'  P  0(.H|0) 

the  ideal  robot  would  have  reached  with  the  same  values  p,,...,p_  of  the  joint 
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variables  in  terms  of  the  joint  errors 

Ap1>...,Ap24 
one  obtains 

1  '“"Pg'  Ap1»...,Apg;  p^/...(p24i‘  Ap7>...,Ap24) 

"  xjP|i*«»Pg»  p7r*..,p24f  Oi«MfO) 

*  Ax.(p.,Ap.)  i  * 

Ap.Apk  ♦  ...  (3.3) 

Ap  »  0 
j  /  s«  (1,...,24) 
k  #  s«  (1,...,24) 

The  first  (real)  values  of  x,,...,x_  are  measured,  the  second  (ideal)  values  of  x,,...,x. 
and  the  derivatives  are  computed  from  the  ideal  forward  solution.  The  problem  of 
calibration  is  to  solve  the  system  of  six  equations  (3.3)  for  the  24  unknowns 
Ap1,...,Ap24.  Clearly,  the  problem  is  undetermined  because  the  same  Cartesian  errors 
can  be  caused  by  various  different  sets  of  joint  errors.  A  strictly  consistent 
evaluation  of  errors  would  only  be  possible  if  their  number  were  restricted  to  six. 
These  six  could  then  be  found  from  the  six  equations  (3.3).  If  less  than  eighteen 
errors  Ap.  do  not  vanish  identically,  they  can  be  consistently  evaluated  if  there  is  no 
explicit  variation  of  Ap.  with  p.,  i.e.,  if  the  errors  do  not  change  across  the  working 
space  of  the  robot.  In  that  case,  four  sets  of  calibration  points  x.<0>,  x.*1*,  x.<2>,  x<3) 
can  be  used  to  form  a  set  of  24  Cartesian  variables.  This  gives  24  equations  of  the 
form 


.fti 

A'  dp. 

Kj 


24  24 


4pi  *  X  X 


32x 


£**  A*  dp  dp 
J“1  J“1 


Ap  «  0 
j  *  s<  (1.....24) 
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24  24  24 

^  ■  Z  K', ip,  *  Z  Z  4piLk  4pi.  *  - 

j*  1  1*  1  k«  t 


(3.4) 


i  *  1,...,24 


where 


,i+n 


ax. 


<n) 


3p, 


ip  >0 
j  f  Sc{1,...,24) 


(3.5) 


and 


a2  W 

Li+n.  Li+n  «  — 8 

jk  ki  3Pj3Pk 

Ap  ■  0 
j  /  S«(1,...,24) 
k  *  S«(1,...,24) 


(3.6) 


are  operators  that  are  linear  and  bilinear  acting  on  Ap..  They  are  known  from  the 

four  real  forward  solutions  used  to  find  x.<0),  x.<1!,  x<2>.  x,{3>.  If  the  expansion  (3.3)  is 
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taken  to  linear  terms  only,  (3.4)  is  a  linear  system  of  24  equations  in  24  unknowns, 
which  can  be  solved  by  inversion.  If  the  expansion  (3.3)  is  taken  to  quadratic  terms, 

(3.4)  is  a  system  of  24  quadratic  equations  in  24  unknowns.  Geometrically  this  is 
equivalent  to  finding  the  intersection  of  24  quadratic  surfaces  in  a  space  of 
dimension  24.  The  system  could  be  solved  by  using  a  linear  guess  followed  by  a 
Newton-Raphson  iteration.  Since  the  expansion  (3.3)  could,  however,  be  combined  to 
any  order  of  Ap.,  it  seems  more  consistent  to  solve  it  by  inversion  of  the  series 

(3.4) .  One  obtains 

4P,  ■  IK’’],,  {  AX.  -  AxttK-’jt(L;  [K-\,Axt  *  ...  }  (3.7) 

with  all  the  indices  running  from  1...24,  summation  over  double  indices  being 
understood. 

If  the  errors  Ap.  vary  across  the  working  space  of  the  robot,  evaluation  of  (3.7)  is 
not  entirely  consistent,  because  the  data  sets  on  the  left-hand  side  of  (3.4)  have  been 
obtained  for  different  sets  of  joint  variables,  and  thus  for  different  errors  Ap.. 
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Each  of  the  points  x.<0\  x.(1>,  x.<2>,  x.<3>  gives  an  undetermined  system  of  equations 
with  infinitely  many  solutions.  The  solution  (3.7)  satisfies  each  of  these  four  sets  of 
six  equations,  but  there  is  no  guarantee  that  it  is  actually  the  physically  correct 
solution  for  each  of  the  four  points.  Continuity  arguments  indicate  that  the  common 
solution  should  be  close  to  the  physically  correct  ones.  If  thefe  is  no  explicit 
variation  across  the  working  space,  the  common  solution  is  indeed  the  correct  one 
for  each  of  the  points.  If  there  is  an  explicit  dependence,  the  choice  of  four 
calibration  points  becomes  problematic:  the  nearer  the  four  calibration  configurations 
are  chosen  to  each  other,  the  more  ill-conditioned  the  problem  becomes 
mathematically;  the  further  away  the  points  are  chosen,  the  more  the  results  Ap  will 
represent  some  average  over  the  six-dimensional  volume  covered  by  the  four  points. 
The  whole  work  space  of  the  robot  could,  however,  be  divided  into  six-dimensional 
simplexes  with  seven  corners  each,  for  each  of  which  the  Ap  are  computed  and 
attributed  to  the  center  of  the  seven  points  involved.  The  resulting 
overdetermination  of  the  problem  would  require  the  use  of  pseudo-inverses.  Some 
polynomial  fit  could  then  be  used  to  represent  the  behavior  of  the  errors  Ap# 
throughout  the  working  volume. 

4  REVERSE  TRANSFORMATION 

Since  at  present  there  is  no  standard  algorithm  available  to  construct  reverse 
solutions  in  general,  they  are  usually  found  by  geometric  intuition  or  trial  and  error. 
Such  an  approach  is,  however,  likely  to  fail  if  the  forward  solution  becomes  complex 
in  the  presence  of  errors.  The  resulting  trigonometric  equations  become  too 
complicated  to  be  solved.  They  can  be  transformed  to  algebraic  equations  via  a 
half-tangent  substitution  (Duffy  1980),  but  these  are  of  high  order  and  difficult  to 
handle. 

The  perturbation  approach  developed  so  far  avoids  the  need  for  the  integral  reverse 
transformation,  what  is  needed  are  relationships  between  perturbations  in  joint  and 
laboratory  space.  Unlike  the  forward  and  the  reverse  transforms,  which  are  highly 
nonlinear,  there  is  a  linear  relationship  between  differential  changes  in  the  Cartesian 
and  differential  changes  in  the  joint  coordinates.  Since  the  forward  solution  of  the 
perturbed  robot  is  known,  it  can  be  differentiated  to  obtain  that  linear  transformation, 
the  Jacobian.  Near  the  singular  points  of  the  robot,  the  joint  motions  become 
linearly  dependent  and  the  Jacobian  becomes  singular.  For  most  positions,  however, 
the  Jacobian  can  be  inverted,  although  that  is  a  time-consuming  process.  An 
additional  complication  arises  because  the  forward  transformation  describes  how  6 


variables  depend  on  6  variables  p,,...,pe  and  on  18  parameters  In 

1  6  1  6  7  24 

the  inverse  transform  the  six  variables  p.,...,p_  depend  on  the  six  Cartesian 
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coordinates  x.,...,xfi,  but  the  eighteen  quantities  p_,...,p.,..  parameterize  the 

ID  *7  24 

transformation.  In  the  case  of  the  real  robot  24  additional  error  terms  Ap1„..,Ap24 
appear  as  parameters. 

In  order  to  find  the  difference  of  the  two  forward  Jacobians  let  us  first  consider  a 


Taylor  expansion  of  the  forward  transformation. 

i 6'  P7'-"'P24'  ^P7'“*'^p24^ 

-  x.(p1,...,p6;  0.....0;  p7,...,p24;  0,...,0) 
dx.  dx 

*  2_[  sr1  Ap, +  X  t1  Ap,  *  ••• 
1=T  3Pj  1  JS T  3p,  1 


i  *  1 . 6 


Ap  =  0 
for 


Ap  *  0 
for 


j  *  Sr  (1,...,24)  j  *  s<{1,...,24) 


24  24  a2 

T  Y-ii- 

Pt  frr3p,3p, 


4p.4pk  . 


Ap  *  0 
*for 

j  *  Sr(1 . 24) 

k  *  sr<1 . 24) 

This  expansion  is  with  respect  to  all  Ap.,  j  =  1.....24  values.  It  is  taken  relative  to 
the  position  of  no  errors  at  all,  which  is  the  position  the  idea!  robot  would  have 
reached. 

By  definition  0  =  Ap?  =  ...  =  Ap24  for  the  ideal  robot  and  the  ideal  Jacobian  is 


dx. 

J  *  - - 

ideal 


i  *  1,...,6 


j  *  1,-,< 


Ap  -  0 
for 

j  *  k«<1,...,24) 


The  ideal  Jacobian  of  (4.2)  and  the  other  coefficients  of  equation  (4.1)  cannot  even  in 
principle,  be  measured  on  the  real  robot  which  is  to  be  calibrated.  They  can  only  be 
computed  from  the  ideal  forward  solution. 


Another  expansion  can  be  performed  with  respect  to  controllable  changes  3p,,...,5p.., 
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with  the  uncontrollable  errors  Ap1#—,Ap24  being  held  constant  at  their  actual  value: 

*  Apg,  p^#— .#p24# 

*  Xj(p  ^  Ap1#...fApg,  Py#*”»P24'  Ap  4P„> 


v  h 
pr  3p, 


5p  *  0 

for 

j  *  s# (1 . 6) 


Ap  *  0 
‘for 

s<(1  $•••$  24) 


i  *  1.....6 


(4.3) 
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3p^ 


JPjJpk  • 


3p  «  0 
for 

j  #  s<(1,...,6) 
k  *  si (1 . 6) 


Ap  *  0 
‘for 

j«(1,.~,24) 
kf  (1,...,24) 


This  expansion  is  taken  relative  to  the  position  with  errors  introduced  because  of 
non-vanishing  Ap1>...,Ap24>  which  is  the  position  the  real  robot  would  reach  without 
adjustments  of  £p 3p _.  By  definition  of  the  real  robot,  the  errors  Ap.  for  k  ■ 
1.....24  do  not  vanish  and  the  real  Jacobian  is 


8x 

J  .  «  -r-1 

dp 

i  *  1,...,6 

(4.4) 

Sp  «  0 

j  «  1,...,6 

Ap  *  0 

for 

for 

j  *  kf(1,...,6) 

k«{1,...,24) 

where  it  is  understood  that  Ap 

. Ap24  are  being  held  constant 

at  the  error  values  of 

the  actual  robot. 

in  principle. 

the  real  Jacobian  (4.4)  can  be 

measured  for  the  real 

robot.  This  could  be  done  by  comparing  the  changes  in  Cartesian  positions  with 
changes  in  Spy...,ipQ.  These  can  be  controlled  arbitrarily,  unlike  the  errors 
Ap  j  Ap24  over  which  there  is  no  control 
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The  task  of  calibration  compensation  is  now  to  compensate  by  adjustments  of 
ip,,....ip.  which,  according  to  (4.4)  propagate  into  Cartesian  changes  through  the  real 
Jacobian,  for  the  Cartesian  changes  introduced  by  the  errors  Ap1,...,Ap24  which, 
according  to  equation  (4.2)  propagate  through  the  ideal  Jacobian.  The  equation  to  be 
satisfied  is 


^  dx. 

Z  *  >p' 


6  6 

zz 


jp  .  o 

Ap  0 

*for 

*for 

j  *  s<(1 . 6) 

s  t  (1.....24) 

32x. 

apSp,, 

jp.jpk  • ... 

for  for 

s  *  j«(1 . 6)  s«(1  »•••#  24) 

s  #  kf  (1,...,6) 


24  24  ^2 


-  Ap.  + 

».  1 

J 

y  <  O  A. 

dp 

J*  1  k*1  HjHk 

ipjip. 

Ap  «  0 

Ap  «  0 

for 

*for 

j  *  s«(1,...,24) 

j  *  S((1,...,24) 

k  *  Sf  (1,...,24) 

This  is  of  the  form 


[J  ]..  ip.  ♦  ip.H'  ip.  ♦  ...  ♦  f.  ■  0 
r  ij  I  1  Ik  rk  i 


1,~.,6 


with  all  indices  running  from  1 . 6,  summation  over  double  indices  being  understood. 

The  linear  coefficient  is  the  real  Jacobian  of  (4.4),  the  quadratic  coefficient  is 


ip.  ■  0 

tor 

s  4  j«(1,...,6) 
s  #  k«(1 . 6) 


Ap  4  0 
*for 

s«(1,...,24) 


The  inhomogeneous  term  is 
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24  24 

w 
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1  s«(1. 

....24) 

i  " 

Sf  (1.....24) 

k  * 

S<  (1,...,24) 

(4.8) 


and  can  be  taken  to  any  power  in  the  errors  Ap..  The  equation  (4.6)  is  of  the  same 
structure  as  equation  (3.4)  and  can  be  solved  by  inversion  with  the  result 


*P. 


(f; 


♦  f  tJ  _13  . 

*  r  Jsj 


H'„ 


h'V* 


...) 


(4.9) 


where  now  all  the  sums  run  from  1,~.,6,  summation  over  double  indices  being 
understood. 


If  Ap?  *  ...  «  Ap24  «  0  one  obtains  simply  that 

iPj  *  ■  Ap.  i  *  1,^,6  (4.10) 

because  for  that  case  Jf  >  J.  ahd  the  two  Jacobians  close.  In  this  case,  the  errors 
Ap(  of  the  joints  are  compensated  by  adjustments  -  Ap.  of  the  joints  themselves.  If 
the  errors  in  the  joint  parameters  Ap?,...,Ap24  do  not  vanish,  they  cause  errors  in  the 
Cartesian  coordinates  that  are  carried  forward  through  the  ideal  forward  solution  and 
ideal  forward  Jacobian,  because  the  robot  was  assumed  error  free.  The  Cartesian 
errors  are  compensated  for  by  adjustments  that  are  carried  forward  through  the  real 
transform  and  Jacobian.  This  is  reflected  in  equation  (4.9)  insofar  as  the  correction 
terms  [Jf  ’]  and  H'.r  refer  to  the  real  robot,  while  the  source  terms  f.  according  to 
(4.8)  refer  to  the  ideal  robot.  The  expansion  (4.9)  is  essentially  an  expansion  of  the 
non-closing  product  [Jr_1][J.]  #  1. 

5  FINAL  REMARKS 

The  problem  under  investigation  is  differential  in  nature  because  small  differences 
between  the  real  and  the  ideal  configuration  are  being  considered.  In  a  similar  way, 
robot  dynamics  is  concerned  with  differential  changes  of  both  world  and  joint 
coordinates  with  respect  to  time.  The  dynamic  problem  becomes  tractable  because. 


unlike  position  transforms,  which  are  highly  nonlinear,  the  rate  of  changes  of  the 
joint  coordinates  and  the  changes  of  the  Cartesian  coordinates  are  linearly  related. 
The  Taylor  expansions  of  the  present  paper  essentially  linearize  the  problem  in  a 
similar  way,  and  make  its  inversion  possible. 

In  recent  years  the  actual  computational  time  required  for  the  solution  of  the 
dynamic  problem  of  ideal,  error-free  robots  has  been  reduced  considerably  by  the 
use  of  iterative  schemes  (Brady,  et  ai.  1982;  Megahed  and  Renaud  1982).  The 
implementation  of  special  purpose  processors  further  decreases  computational  times 
by  up  to  two  orders  of  magnitude  (Ouelen,  Kirchhoff  and  Held  1984).  One  could  hope 
that  similar  economics  could  advance  the  technique  developed  in  this  paper  to  actual 
on-line  implementation.  On  the  kinematic  level  this  would  mean  calibrated  motion  of 
the  real  robot.  On  the  dynamic  level  the  goal  is  the  use  of  the  real  rather  than  the 
ideal  Jacobian. 

In  literature,  it  has  been  recognized  (or  rather  remembered)  that  screw  theory  or 
motor  calculus  are  suitable  instruments  for  handling  this  type  of  problem  (Ball  1900; 
v.  Mises  1924;  Rooney  1978;  Featherstone  1983,  1984;  Sugimoto  and  Duffy  1982; 
Sugimoto  1984;  Hunt  1984).  The  six  components  of  the  most  general  displacement 
possible  are  represented  without  redundancy  in  that  six  dimensional  vectorial 
approach,  and  the  redundancy  of  the  4  x  4  homogeneous  matrices  is  avoided.  For 
notational  reasons  we  prefer  the  purely  multiplicative  structure  of  the  conventional 
notation  accepted  by  roboticists. 
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